arXivrl 509.04806v 1 [cs.RO] 16 Sep 2015 


A Framework for Fine Robotic Assembly 

Francisco Suarez-Ruiz and Quang-Cuong Pham 


Abstract —Fine robotic assembly, in which the parts to be 
assembled are small and fragile and lie in an unstructured 
environment, is still out of reach of today’s industrial robots. 
The main difficulties arise in the precise localization of the 
parts in an unstructured environment and the control of contact 
interactions. Our contribution in this paper is twofold. First, 
we propose a taxonomy of the manipulation primitives that 
are specifically involved in fine assembly. Such a taxonomy is 
crucial for designing a scalable robotic system (both hardware 
and software) given the complexity of real-world assembly 
tasks. Second, we present a hardware and software architecture 
where we have addressed, in an integrated way, a number of 
issues arising in fine assembly, such as workspace optimization, 
external wrench compensation, position-based force control, etc. 
Finally, we show the above taxonomy and architecture in action 
on a highly dexterous task - bimanual pin insertion - which is 
one of the key steps in our long term project, the autonomous 
assembly of an IKEA chair. 

I. Introduction 

Robotics has largely contributed to increasing industrial 
productivity and to helping factory workers on tedious, 
monotonous tasks, such as pick and place, welding, or 
painting. There are however some major challenges that still 
prevent the automation of many repetitive tasks - especially 
in ‘light’ industries - such as the assembly of small parts in 
the electronics, shoes or food industries. 

As opposed to ‘heavy’ industries, where sophisticated 
assembly lines provide a highly structured environment (for 
instance, on car assembly lines, the position of the car frame 
is known to sub-millimeter precision), ‘light’ industries are 
associated with unstructured environments, where the small 
parts to be assembled are placed in diverse positions and 
orientations. While tremendous progress has been made in 
3D perception in recent years, current 3D-vision systems are 
still not precise enough for fine assembly. 

Another related problem is that most robots currently 
used in the industry are position-controlled , that is, they 
can achieve very precise control in position and velocity, 
at the expense of poor, or no, control in force and torque. 
Yet, force or compliant control is crucial while assembling 
fragile, soft, small parts. Assembly tasks imply by essence 
contacts between the robot and the environment, making the 
sensing and control of contact forces decisive. A number of 
compliant robots have been developed in recent years, such 
as the KUKA Lightweight Robot [1] or the Barrett Whole 
Arm Manipulator (WAM) [2], but, compared to existing 
industrial robots, they are still one order of magnitude 
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more expensive, less robust and more difficult to maintain. 
We believe therefore that the key to automatizing ‘light’ 
industries lies in augmenting existing industrial position- 
controlled manipulators with extra functionalities, such as 
compliant control, through the addition of affordable hard¬ 
ware components (e.g. end-effector force/torque sensor) and 
smart planning, sensing and control software. 

The goal of this paper is to present our framework 
dedicated to fine assembly - our long term project being 
to demonstrate the capability of that framework by au¬ 
tonomously assembling an IKEA chair. 

Previous works have attempted to complete similar tasks 
[3], [4], [5]. Specifically, Knepper et al. [4] present a multi¬ 
robot system that assembles an IKEA table. They focus more 
on the task planning architecture than in the challenges of 
fine assembly. To cope with the force interactions they need 
a dedicated tool based on a compliant gripper for screwing 
the table legs. In order to use off-the-shelf components, we 
prefer software over mechanical compliance. 

In this paper, we discuss two initial contributions. First, we 
propose a taxonomy of the manipulation primitives involved 
in fine assembly. Such a taxonomy serves as crucial guideline 
for designing a scalable robotic manipulation system (both 
hardware and software), given the complexity of real-world 
assembly tasks. In particular, thinking in terms of primitives 
moves beyond the low-level representations of the robot’s 
movements (classically joint-space or task-space) and en¬ 
ables generalizing robot capabilities in terms of elemental 
actions that can be grouped together to complete any task. 

As our taxonomy is tailored for industrial fine assembly, it 
differs from existing manipulation taxonomies [6], [7], [8], 
[9] in two key aspects: (i) we focus on parallel-jaw grippers 
(the most common and robust gripper in the industry), which 
excludes some complex primitives such as in-hand manipu¬ 
lation; (ii) in addition to the interaction of the gripper with 
the gripped object, we also consider multi-object interactions 
(e.g. the gripped object interacts with another object), which 
constitute the essence of assembly. 

Our second contribution is the development of a hardware 
and software framework based on the above taxonomy and 
tailored for robotic assembly. The hardware comprises an 
optical motion capture system and two industrial position- 
controlled manipulators, each equipped with a force/torque 
(F/T) sensor at the wrist and a parallel gripper. The two 
manipulators are necessary since most assembly tasks require 
two hands to complete (see [10] for a complete survey on 
bimanual manipulation). Compared to integrated bimanual 
robots, such as the Toyota Dual Arm Robot [11], the 
Yaskawa Motoman SDA10D [12], or the ABB dual arm 



YuMI [13], our two independent manipulators enable higher 
workload and larger workspace, at a fraction of the cost. 

On the software side, we address a number of issues 
arising in fine assembly, such as workspace optimization, 
external wrench compensation, position-based force control, 
etc. These issues have often been discussed in the literature, 
but we address them here in an integrated way and on a single 
software platform built on top of the Robot Operating System 
(ROS) [14]. We intend to make this platform available as 
open-source in the near future. 

To illustrate the above developments, we consider a highly 
dexterous task: bimanual pin insertion. This task requires 
most of the capabilities just mentioned, such as bimanual 
motion planning, object localization, control of contact in¬ 
teractions, etc. It also constitutes one of the key steps in 
our long term project, the autonomous assembly of an IKEA 
chair. Finally, it yields a fully quantifiable way to measure the 
dexterous performance of a robotic manipulation system and 
is therefore a good test for the generalizability and simplicity 
of implementation. 

The paper is structured as follows. In Section [II] the 
proposed manipulation taxonomy is presented. The manipu¬ 
lation primitives have been selected for assembly tasks, 
but can also be used for the description of any type of 
robotic tasks. Section [HI] gives details regarding our hardware 
and software framework and describes the requirements that 
we have identified as essential to perform all the motion 
primitives. Section [IV] depicts the bimanual pin insertion 
task, showing how it can be broken down into different 
subtasks, which in turn can be divided into manipulation 
primitives. Finally, Section [V] draws some conclusions and 
sketches some directions for future research. 

II. Manipulation Primitives for Assembly 

We present a motion-centric taxonomy that classifies ma¬ 
nipulation primitives required for assembly tasks. Typically, 
two different approaches have been used in previous taxo¬ 
nomies: object- [6], [7] or motion-centric [8], [9]. Object¬ 
centric classifications define the primitives focusing on the 
characteristics of the manipulated object, which compli¬ 
cates their extension to different type of systems. On the 
other hand, motion-centric typologies allow to use different 
strategies to complete the same task. This flexible approach 
can be adapted to diverse manipulation systems depending 
on their capabilities. Our taxonomy focuses on industrial 
manipulators equipped with a parallel-jaw gripper. In the 
case of more complex end-effectors, in-hand manipulation 
primitives can be used [8]. 

A. Definitions 

• Task. High-level work to be done by the robotic ma¬ 
nipulation system, e.g. bimanual insertion of a pin into 
a wood stick. 

• Subtask. Functional division of a task, e.g. grasping a 
pin, picking a stick, or inserting a pin. A task normally 
include several subtasks. 


• Manipulation Primitive. Basic action defined in the 
taxonomy. Typically, various primitives constitute a sub¬ 
task. Moreover, they comprise the basic capabilities that 
the software framework provides for each manipulator. 

• Prehensile. The hand/gripper can stabilize the object 
without need for external forces such as gravity. Ba¬ 
sically, the object is grasped. 

• Contact. The hand/gripper or the object being grasped 
is touching any external body. 

• Motion. The end-effector is moving with respect to the 
robot’s coordinate frame. 

• Push/Pull. A force is applied and the object being 
manipulated is moving as a result. 

B. Manipulation Taxonomy 

Taxonomies classify information into descriptive groups. 
In robotics, taxonomies are usually used to define the possi¬ 
ble grasps of dexterous robotic hands [6], [7]. These kind 
of taxonomies focus mainly on in-hand movements and 
disregard the larger movements of a robotic manipulator. 

Similarly to [8] and [9], a motion-centric approach has 
been adopted for the taxonomy proposed in this work. It 
allows for greater flexibility than an object-centric approach, 
which would restrict the manipulation to the a priori knowl¬ 
edge of the object. The motion-centric approach is suitable 
for any manipulation performed by a hand-type manipulator. 
Fig. [T] shows the motion-centric taxonomy proposed in this 
work. It is independent to the object being manipulated. For 
the classification of bimanual manipulation tasks, the primi¬ 
tives can describe the actions performed by each manipulator. 

C. Primitives Requirements 

Once the manipulation primitives have been defined, it is 
needed to determine their specific requirements. As shown in 
Fig. |T] there are three natural levels of difficulty depending 
on the number of objects involved in the manipulation. For 
a position-controlled manipulator, contact interactions repre¬ 
sent an additional challenge, which prompts us to indicate the 
control mode required for each primitive in the taxonomy. 

1) Position Mode: This control mode is used for all the 
primitives that do not involve contact interactions. Despite 
of being inherently simple for a position-controlled manipu¬ 
lator, this mode requires precise localization of the objects 
when the robot moves in their proximity. For instance, if 
the robot needs to grasp and object, first it will approach to 
the grasp position (primitive \2\ ), but errors in the position 
estimation may result on the robot hitting the object and 
failing the task. 

2) Compliant Mode: This mode is used for primitives 
where there are contact interactions between the gripper and 
the object or between the gripped object and another ob¬ 
ject. Depending on the task, force- or impedance-controlled 
motion will be used. One example of a force-controlled 
primitive is number (T) . It can be used to maintain 
contact with a table while the gripper is closed to grasp a 
small object. In this case, controlling the force guarantees 
the contact between the gripper and the table and avoids 
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Fig. 1. Manipulation taxonomy proposed in this work. Any robotic manipulation task can be classified using these primitives. There are three levels of 
difficulty depending on the number of objects the robot is interacting with. The control mode is indicated by the shape enclosing the primitive number. A 
rectangle indicates position-control mode. An ellipse indicates compliant-control mode. 


unwanted interaction forces. An example of an impedance- 
controlled primitive is number (15) . Imagine a task where the 
force required to extract an object is unknown, therefore the 
force-controlled approach may fail. Moreover, this compliant 
mode can be used to reduce the uncertainty in the localization 
of the objects. For instance, the robot can detect the exact 
position of the object once it detects a contact. 

III. Hardware and Software Platform 

The robotic platform used in this work is characterized 
by cost-efficient, off-the-shelf components combined with 
classical position-control industrial manipulators. This will 
help address the problems of fine assembly under unstruc¬ 
tured environments at a limited cost. 

The main components of the proposed platform are: 

• 2 x Denso VS060: Six-axis industrial manipulator. 


• 2 x Robotiq Gripper 2-Finger 85: Parallel adaptive 
gripper designed for industrial applications. Closure 
position, velocity and force can be controlled. The 
gripper opening goes from 0 to 85 mm. The grip force 
ranges from 30 to 100 N. 

• 2 x ATI Gamma Force-Torque (F/T) Sensor: It mea¬ 
sures all six components of force and torque. They 
are calibrated with the following sensing ranges: / = 
[32, 32,100] N and rm [2.5, 2.5, 2.5] Nm. 

• lx Optitrack Motion Capture System: Six Prime 17W 
cameras that can track up to five rigid bodies. The error 
in position and orientation estimation is directly related 
to the amount of markers used per rigid body (minimum 
three markers are required). We have observed that the 
estimation error ranges between ±0.5 — 3 mm for the 
position and ±0.01 — 0.05 radians for the orientation. 
This estimation error is due to the diameter of the 

































Fig. 2. Kinematic diagram of the bimanual setup. The distance d has been 
optimized to maximize the joint and intersection workspaces. 


markers which ranges between 3 to 10 mm in our setup. 

A. Bimanual Workspace Optimization 

Appropriate values for the distance between the two robots 
(d in Fig. [2]) can be selected either by trial and error or by 
solving an optimization problem with constraints imposed as 
a function of the resulting reachable workspace. The typical 
approach to quantify the manipulability of serial robots is to 
use a quality value for reachable positions along the robot’s 
workspace. Normally the Yoshikawa’s manipulability index 
[15] is used: 


w = 



( 1 ) 


This value describes the distance to singular configurations 
but it does not consider the robot’s joint limits. A modified 
index can be penalize to account for the effects of the joint 
limits on the manipulability of a serial manipulator. 


P(Q) = E 
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We use the penalization function ^ proposed in [16], 
which results in the modified index w* = p^y- 

Finally, we maximize a linear combination between the 
union and the intersection workspace that is a function of the 
distance d. The resulting workspace of the bimanual setup is 
shown in Fig. [2] where the optimized distance is d — 1.042 
meters. 


B. Motion Planning in Free Space 

For all the collision-free movements the Bi-directional 
Rapidly-Exploring Random Trees (RRTs) algorithm [17] 



Fig. 3. Normalized reachability of the bimanual setup. The workspace 
intersection shows the combined reachability of the two manipulators. 


available in OpenRAVE [18] is used. Similarly to LaValle 
in [19], our system uses prioritized planning. The motion 
path is calculated for one robot at the time and is repeated 
until all the movements are completed. This reduces the 
overload in collision checking and avoids the need for path 
coordination between robots. 

C. External Wrenches Estimation 

In our setup, one F/T sensor is mounted at the wrist of 
each robot. It measures the dynamic effects of the end- 
effector and any external wrench due to contact interactions 
with the environment. External wrenches can be estimated 
by compensating the dynamic effects of the end-effector 
(weight and inertia) [20], [21], [22]. This approach requires 
the identification of the inertial parameter of the end-effector. 
We propose an off-line approach which only uses the F/T 
sensor measurements along a defined trajectory. 

1) Optimal Excitation Trajectories: During the identifi¬ 
cation process, it is necessary to ensure that the excitation 
is sufficient to provide accurate and fast parameter estima¬ 
tion in the presence of disturbances, and that the collected 
data is simple and yields reliable results. First, a trajectory 
parametrization is selected, and second the trajectory pa¬ 
rameters are calculated by means of optimization. 

The excitation trajectory for each joint has been chosen as 
a finite sum of harmonic sine and cosine functions, similar to 
[20], [21]. Each one with a total of 27V+1 parameters, which 
correspond to the degrees of freedom of the optimization 
problem. 
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Fig. 4. Optimized robot-excitation trajectory. One period of the optimized 
joint trajectories is shown. These trajectories consist of a five-term Fourier 
series with a base frequency of 0.1 Hz. The trajectory parameters are 
optimized according to the d-optimality criterion, taking into account 
workspace limitations, and constraints on joint velocities and accelerations. 

The coefficients and bj are the amplitudes of the sine and 
cosine functions, q® is the offset of the position trajectory. 

Fig. [4] shows the optimized trajectory for the six robot’s 
joints (11 parameters per joint). The base frequency has been 
selected in order to cover a larger part of the robot workspace 
for the given maximum joint velocities and accelerations, 
even thought it requires a longer measurement time. The 
identification process is performed off-line for each end- 
effector. 

2) End-effector Dynamics: The wrist-mounted F/T sensor 
is measuring the loads on the last link excluding itself. In 
particular, since the end-effector is always present, it is pos¬ 
sible to compensate the wrench it generates by determining 
its inertial parameters. The Newton-Euler equation of this 
last body refereed to the F/T sensor frame O s is, 

f s = -^s^s H - v s X IsV s 5 ( 6 ) 

where the resulting spatial force f s is a function of 
the spatial inertia I s , the spatial acceleration a s , and the 
spatial velocity v s . As shown in [22], the force and torque 
measurements by the wrist sensor must be expressed in terms 
of the product of known values and the unknown inertial 
parameters. The measured wrench f s can be written as: 


\a, S(w s ) + S(w,)S(w s ) 

° 1 

m s 

[0 -S(a s ) 

L(w,) + S(w s )i(w s )J 
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where L(u> s ) is a 3 x 6 matrix of angular velocity 
elements, l (I s ) is the inertia matrix vectorized and S (u> s ) 
is the skew-symmetric matrix. 0 can be expressed more 
compactly as, 

fs =A s cf> s , (8) 

where A s is a 6 x 10 matrix, and (j) s is the vector of the 
10 unknown inertial parameters. To estimate the force/torque 



Fig. 5. Position-based explicit force control. 


offsets, the matrix A s is augmented by the identity matrix 
E and the parameters vector is expanded to include the 
offsets f 0 and r 0 to be estimated: 

ti=[fo To rn s c s 1{I S )] T 
A* = [E 6x6 A s ] 

D. Position-Based Explicit Force Control 

The idea of a position-based explicit controller is to 
take a position-controlled manipulator as a baseline system 
and make the necessary modifications to achieve compliant 
motion control [23], [24]. Fig. [5] shows the adopted force 
control scheme, where x r is the reference position and 
f r the force setpoint when the robots interacts with the 
environment. The contact force f s is fed back to the force 
compensator which produces a perturbation Xf, so that the 
end-effector tracks the modified commanded trajectory x c . 
Thus the force feedback law is given by 

x f(t) = kpfe(t) 1 (9) 

This controller ensures uniform performance when in contact 
with environments having unknown stiffness. For details 
regarding the controller’s robustness see [24], [25]. 

Currently, we have tested two compliant controllers: ex¬ 
plicit force control and admittance control. Initially, our idea 
was to implement the explicit force controller only for the 
contact-without-motion primitives ( (T) and (13) ) but after 
some experimental trials, we found that this controller was 
also capable of performing primitives (14) and (J6) . 
Therefore, for the bimanual pin insertion task, we use the 
explicit force controller for the compliant mode. We believe 
that for the next steps of our long term project (assembling 
an IKEA chair), more complex compliant controllers will 
be needed, specially for bimanual collaborative manipulation 
tasks like flipping the chair using both arms. 

IV. Example: Bimanual Pin Insertion 

As discussed in Section [I| we have chosen a bimanual pin 
insertion task for the evaluation of the proposed framework. 
This task starts with a cylindrical pin (r = 4 mm, l = 30 mm) 
and a wood stick (20 x 50 x 270 mm) on a table. The left 
arm picks the pin, the right arm picks the stick, and both 
arms move to the insertion area (a location where the two 
manipulators can reach). The left arm uses the pin to explore 













































TABLE I 

Parameters of the peg-in-hole task used for the assessment 

OF THE BIMANUAL MANIPULATION SYSTEM. 


TABLE II 

Manipulation primitives used for the bimanual pin insertion 
task. The time to task completion is 83 seconds. 


Parameter 

Symbol 

Value 

Hole diameter 

d H 

8.1 mm 

Peg diameter 

dp 

8 mm 

Peg height 

h 

30 mm 


the stick and to find the hole. Once it finds the hole, inserts 
and releases the pin. 

The task is naturally divided into three mid-level sub-tasks: 

• Compliant grasp of the pin, 

• Pick & place the stick, and 

• Compliant insertion of the pin 

A. Compliant Grasping 

Moving the left arm to grasp directly the pin is not possible 
due to two uncertainties in the system: First, the position 
error in the perception system can be up to ±3 mm. Second, 
the difference in the height of the gripper between the opened 
and the closed position is 13.9 mm. These two factors along 
with the mechanical compliance of the gripper at the tip 
(intended for encompassing grip) require extra capabilities 
to grasp small objects from the table top. 

To cope with this, we use a compliant grasping approach. 
Initially, the robot moves to a pregrasp position, just above 
the pin, then it moves down until it detects contact with 
the table. The position-based explicit force controller is then 
used to maintain the contact with the table within a safe 
value that does not overcome the compliance of the gripper’s 
tip. Finally the gripper is closed while the force controller 
maintains the contact with the table. 

B. Pick & Place 

This is a simpler sub-task. The right arm picks the stick 
and ‘place’ it in the insertion area. It needs to be hold tightly 
so that the left arm can perform the exploration, find the hole 
and insert the pin. 

C. Compliant Pin Insertion 

The insertion sub-task is of the peg-in-hole type. This kind 
of setup is generally characterized using a precision value 
defined as, 

J = log 2 ( , ~ , V (10) 


Time [s] 
Start End 


Primitive 


Action 


Compliant Grasping (left arm, 13 seconds.) 


0 

9 

m 

Approach to the pregrasp position 

9 

10 

CD 

Contact with the table 

10 

11 

CD 

Close gripper maintaining contact 

11 

12 

a 

Grasp the pin 

12 

13 

tm 

Pick-up the pin from the table 

Pick & Place (right arm, 

18 seconds.) 

13 

22 

a 

Approach to the grasp position 

22 

24 

a 

Grasp the stick 

24 

31 

mi 

Move the stick to the insertion area 

Compliant Pin Insertion (left arm, 52 seconds.) 

31 

40 

M 

Move the pin above the stick 

40 

43 

C3> 

Contact between the pin and stick 

43 

56 

COD 

Detect first edge of the stick 

56 

59 

m 

Move above and contact the stick 

59 

70 

COD 

Detect second edge of the stick 

70 

73 

GS 

Move above and contact the stick 

73 

80 

COD 

Find the hole 

80 

82 

COD 

Insert the pin 

82 

83 

a 

Release the pin 


K dn ~ dp ) 

where dp is the diameter of the hole and dp is the diameter 
of the peg. Table [T| shows the parameters for our pin insertion 
setup, which has a precision value I = 6.34 bits. Other 
studies have used precision values within the same order of 
magnitude [26], [27] in telemanipulation applications where 
the operator deals with the challenge of localizing precisely 
the hole. 

Due to the uncertainties on the position of the objects 
(pin and stick), the exact position of the holes is unknown. 
Moreover, given the parameters of the peg-in-hole setup 
(Table [I]), we have observed that the insertion fails for 


position errors above 0.5 mm. To cope with these problems, 
we perform a force-controlled exploration of the wood stick 
using the pin. The left arm moves above the stick with the pin 
grasped, then starts moving down until contact is detected. 
Next, we look for two edges of the stick. Considering that 
its dimensions are known, after finding the edges, the middle 
axis of the holes can be calculated. The robot ‘scratches’ 
the pin over the stick following that axis until it finds the 
hole. After that, a force-controlled motion is carried out 
f = [0, 0, — f z \ to insert the pin. This value ensures that the 
pin will move only in the — z direction until it reaches the 
bottom of the hole or the gripper touches the stick. From (|9j), 
it can be seen that the pin is driven down the distance x / until 
the force error f e equals to zero. This motion emulates and 
spring-damper impedance that depends on the compensator 
gains k p and k v . Finally the left arm releases the pin and 
moves back to its home position. 

Table [II] depicts the manipulation primitives required for 
each sub-task with their corresponding times. The time to 
task completion for the bimanual pin insertion is 83 seconds. 
Fig. [6] depicts the transitions between manipulation primitives 
in a time-line representation. Fig. [7] shows snapshots of the 
bimanual pin insertion where each sub-task can be visually 
identify. The complete video can be found athttp://goo. 
gl/cY19sq, 

V. Conclusions and Future Work 

This paper introduced a complete framework for fine 
assembly tasks using industrial robots. We have presented 
a new taxonomy of manipulation primitives tailored for 
industrial fine assembly. This taxonomy focuses on parallel- 
jaw grippers and interactions with single or multiple objects 
which are the essence of assembly tasks. Moreover, we have 
discussed the development and implementation of a software 
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6. Time-line representation of the manipulation primitives used for the bimanual pin insertion task. Only six (6) manipulation primitives are required. 







Fig. 7. Snapshots of the bimanual pin insertion, a) The initial position. The positions of the table, stick and pin are determined using Optitrack. b) The 
left arm performs the compliant grasping of the pin. c) The right arm grasps the stick, d) The right arm ‘places’ the stick in a position where the insertion 
can take place, e) The left arm moves above the stick and detects the contact with the pin. f) Through force exploration, the left arm finds the first edge 
of the stick, g) The left arm finds the second edge of the stick, h) Using the refined position of the two edges, the system knows where the middle axis is 
and can find the hole, i) Once the hole is found, the left arm inserts the pin. j) Finally, the left arm releases the pin and moves back to its home position. 
The complete video can be found at http://goo.gl/cY19sq 


and hardware framework for bimanual manipulation. Our 
experimental setup shows that fine assembly manipulation 
can be successfully implemented on an industrial system that 
was originally built to be position-controlled. 

Our approach combines the robustness, high-precision 
and repeatability of position-controlled industrial robots with 
compliant control. The requirements and challenges that arise 
in bimanual manipulation have been covered. 

Through the integration of manipulation primitives, 
workspace manipulability optimization, collision-free motion 
planning, external wrenches estimation and position-based 
explicit force control, we achieved a highly dexterous task: 
bimanual pin insertion. 


Future works will include the use of 3D perception 
systems suitable for industrial applications and the fusion 
of perception and force information to improve the explo¬ 


ration phase described in Section |IV-C| On the bimanual 
collision-free motion planning, the use of coordinated mo¬ 
tions promises to reduce the time to task completion. Ad¬ 
ditional work needs to be done in regards of compliant 
controllers for bimanual collaborative manipulation. Finally, 
this work will continue until completion of all the tasks 
required for assembling an IKEA chair. 
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